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(57) ABSTRACT 

A system and method for determining a location of a mobile 
object is provided. The system determines the location of the 
mobile object by determining distances between a plurality of 
sensors provided on a first and second movable parts of the 
mobile object. A stride length, heading, and separation dis- 
tance between the first and second movable parts are com- 
puted based on the determined distances and the location of 
the mobile object is determined based on the computed stride 
length, heading, and separation distance. 
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METHOD AND SYSTEM FOR DETERMINING above, and an exemplary embodiment of the present disclo- 

RELATIVE DISPLACEMENT AND HEADING sure may not overcome any of the problems listed above. 

FOR NAVIGATION Exemplary implementations of the present disclosure pro- 

vide a novel technique for measuring and collecting data. 


CROSS-REFERENCE TO RELATED PATENT 
APPLICATION 

This application claims priority from U.S. Provisional 
Application No. 61/258,973 filed on Nov. 6, 2009, the disclo- 
sure of which is incorporated herein by reference in their 
entirety. 

STATEMENT REGARDING FEDERALLY 
SPONSORED R&D 

This invention was made with government support under 
NNX08AF14G awarded by Department of Homeland Secu- 
rity (through NASA). The government has certain rights in 
the invention. 

BACKGROUND 

1. Technical Field 

Apparatuses and methods consistent with the present dis- 
closure relate to navigation systems capable of providing 
highly accurate location information. 

2. Description of the Related Art 

Personal navigation systems capable of providing highly 
accurate location information are sought after for various 
applications. For example, personal navigation system that 
can be used in global positioning system (GPS) denied envi- 
ronments or GPS-disrupted environments are sought after for 
military, first responder, and consumer applications. There is 
a need for personal navigation systems suitable for environ- 
ments in which there is line-of-sight blockage (e.g., build- 
ings, forest canopy, caves, etc.) and/or electrical interference/ 
jamming. Also, such personal navigation systems can be used 
in clinical research to accurately measure motion of patients 
during therapy. 

Conventional personal navigation systems use an inertial 
measurement unit (IMU), or some subset of inertial sensors, 
to measure changes in position and heading to track the move- 
ment of a person, ground vehicle, or air vehicle. These sys- 
tems can also use digital pedometers that measure the impact 
strike of each foot and use an average stride length to compute 
distance traveled. These pedometers use small accelerom- 
eters to measure when each foot hits the ground. Many IMUs 
incorporate magnetometers for determining heading or direc- 
tion using the Earth’s magnetic field. However, these mea- 
surements are often corrupted inside buildings or structures 
due to the presence of magnetically interfering iron or elec- 
tromagnetic fields. 

US 20090326795 provides an example of a related art 
personal navigation system. A stride vector technique is pre- 
sented for a pair of first and second objects, such as a pair of 
boots or shoes worn by a user and integrated with a personal 
navigation system for the user. Using the stride vector tech- 
nique, a position vector is measured between user’s two feet 
by using information gathered by sensors disposed on each 
foot. 

SUMMARY 

Exemplary embodiments of the present disclosure address 
at least the above problems and/or disadvantages and other 
disadvantages not described above. Also, the present disclo- 
sure is not required to overcome the disadvantages described 


5 which can be used in the accurate determination of distance 
and direction traveled by an object such as an individual. 

According to an exemplary implementation of the present 
disclosure a plurality of sensors are placed upon an individu- 
al’s feet (both right and left). These sensors operate either/ 
10 both as transmitters or receivers that directly measure the 
distance, or displacement, between nodes on each foot in a 
continuous manner. A unique algorithm is presented that uses 
this sensor displacement data to compute the accurate step or 
stride length between feet, the heading or direction of one foot 
15 relative to the other, and vertical or altitude, displacement of 
one foot relative to the other. 

BRIEF DESCRIPTION OF THE DRAWINGS 

20 The above and other features and advantages of the present 
disclosure will become more apparent by describing in detail 
exemplary implementations thereof with reference to the 
attached drawings in which: 

FIG. 1 illustrates an exemplary system for determining 
25 location of a mobile object. 

FIG. 2 illustrates an exemplary sensor configuration for an 
exemplary mobile object. 

FIG. 3 illustrates an exemplary technique for measuring a 
stride length. 

30 FIG. 4 illustrates an exemplary technique for measuring a 
heading. 

FIG. 5 illustrates an exemplary technique for measuring a 
stride length, heading, and separation distance. 

FIG. 6 illustrates another exemplary technique for measur- 
35 ing a stride length, heading, and separation distance in an 
absolute frame of reference (inertial frame of reference). 

FIG. 7 illustrates another exemplary technique for measur- 
ing a stride length, heading, and separation distance in a 
relative reference frame. 

40 FIG. 8 illustrates a system for extending the techniques for 
FIGS. 6 and 7 to determine 3-D location. 

FIG. 9 illustrates an exemplary method for determining a 
location of a mobile object. 

45 DETAILED DESCRIPTION 

Exemplary implementations of the present disclosure will 
now be described more fully with reference to the accompa- 
nying drawings. 

50 FIG. 1 illustrates an exemplary system in which a central 
node 101 determines a location of mobile objects 102, 103, 
and 104. The central node 101 may be implemented on a 
processor. The central node 101 communicates with sensors 
201 installed on each of the moving objects 102, 103, and 104 
55 to determine their position with respect to the central node’s 
frame of reference. It is also possible that the mobile objects 
communicate with each other to determine each other’s rela- 
tive position. The central node 101 can correspond to a pro- 
cessor located at a fiducial point (such as an entrance to a 
60 building). The communication between the central node 101 
and the mobile objects may be carried out through a wireless 
medium such as Bluetooth, RF, optical, etc. According to an 
exemplary implementation, a controller 110 communicates 
with each of the plurality of sensors 201 on a mobile object 
65 and co mmu nicates certain measurements to the central node. 
As an example, each of the mobile nodes 102, 103, and 104 
may be provided with a controller 110 that gathers data from 
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sensor nodes on a mobile object, determines certain informa- 
tion from the gathered data, and communicates the certain 
information to the central node. Hie controller may be imple- 
mented on a processor and may include a transmitting unit 
111, a receiving unit 112, a processing unit 113, and a storage 
unit 114. The transmitting unit 111 transmits data to the 
central node. The receiving unit 112 receives data from the 
sensor nodes. The processing unit 113 processes the received 
information and generates the information to be sent to the 
central node. The storage unit 114 stores information prede- 
termined for the system and also stores intermediate results. 

The central node may also be placed directly on the indi- 
vidual’s or object’s parts so that the relative movement of the 
mobile objects may be determined. The central node may 
contain a clock to maintain synchronization of transmitted 
data between all remote nodes. 

To describe in detail the exemplary system of FIG. 1, an 
exemplary sensor configuration is described in FIG. 2, in 
which the objects 102, 103, and 104 correspond to first 
responders such as firefighters. It should be noted that indi- 
viduals such as first responders are only examples of objects 
and the location information of any mobile object can be 
accurately determined by the system of FIGS. 1 and 2. For 
example, the mobile object could be a robot on which wire- 
less sensors are disposed for communication with a central 
node. As another example, the mobile objects could be friends 
or co-workers that seek location information of others within 
a social-networking environment. 

FIG. 2 illustrates a group of sensors 201 (A, B, C, and D) 
installed on a mobile object 102. In the case of FIG. 2, the 
group of sensors 201 are installed on a right and left boot of a 
first responder. In FIG. 2, ‘s’ corresponds to a separation 
distance between the two feet of a first responder. The group 
of sensors may communicate with each other through a wire- 
less medium and determine a distance between each other. 
Alternatively, the controller 110 may be provided on the 
mobile object that calculates the distance between each of the 
sensors 201. Such a controller 110 may be installed in a 
plurality of locations on the mobile object. For example, the 
controller may be installed on one of the boots, it may be 
strapped to the body of the first responder, or one of the 
sensors itself may function as the controller. It should be 
noted that the above examples are only for purposes of illus- 
tration and many such implementations will be apparent to 
one of ordinary skill in the art. 

Next, an exemplary technique is illustrated with reference 
to FIG. 3 using which a location of a first responder can be 
determined. If it is assumed that a distance between the feet of 
a first responder remains the same when he moves in a straight 
line, then a stride length ‘L’ can be calculated as follows: 



then 

£= GcSm(<t>) 

Alternatively, ‘L,’ can also be calculated using: 



L =^ Ted 2 --* 2 


4 

The above calculation assumes that ‘s’ is known. The value 
of ‘s’ can be determined by prior experimentation and the 
values R JC and R sz , can be calculated by the controller. 
Accordingly, the stride length ‘L’ can be determined. 

5 FIG. 4 illustrates another exemplary technique in which a 
relative foot rotation can be determined while a first 
responder is in a standing position. The relative rotation of 
R AB is determined as the heading of the right foot with respect 
to the left foot. If the heading is non-zero, then the stride 
to separation between the heels will not equal the stride separa- 
tion between the toes. 

In FIG. 4, the controller determines the heading rj) by 
determining R JS (distance between sensors on the same foot), 
R JC and R />/,.- 
15 

, . { r A C~ r BD\ . IBaC-S 2\ 

:7> = arcsinl 7 arcsm 

' r„ B / ' r AS I 

20 FIG. 5 illustrates an exemplary technique for determining 
a stride length and a heading of a first responder. In FIG. 5, the 
stride length ‘L2’ is measured based on relative displacement 
of two sensors B and D, which are provided on the heels of the 
right and left foot, respectively. The controller measures R JC , 
R/./r R /zj' IUc- ond Ry-z> Also, Ryzy and R^xj can be 
directly measured and known prior to operation based upon 
their initial placement of these nodes in the boots. These are 
the values which the controller can measure directly. Since 
the measured values are distances, the notation of distance is 
3< 1 independent of the direction, so that R 7 /=R y7 should be appar- 
ent to one skilled in the art. The controllerthen determines the 
stride length ‘L2’ and heading based on the following: 

r BC 2=r CD 2+r BD 2 ~2 r CI?BD COs(90°-j> 2 ) 

35 Using the above equation, sin ij>2 can be determined and 
based on that the stride length ‘L2’ can be determined as 
follows: 

I 2 =sin(j> 2 )/ B£) 

40 Similarly, ‘s2’ can be calculated: 

s 2 =cos(ty 2 )r BD 

It should be noted that the variables having the ‘tilda’ sign 
are the variables which are to estimated or determined. To 
45 determine the heading, the following equations are used: 

^ACD=y:r^, 2 =^ c 2 +r a , 2 -2r j<c r CD [cos(v)] 

50 Si = sin(y)-r„ c 

= h + P 

I ■ i P \ ■ f S ‘ ~ S2 ) 

ip = arcsm = arcsml 

x r AB ’ V r AB ) 

55 

In the above equations, cosine(angle ACD) is computed 
and based on this computation, ‘si’ is determined because 
R 7C is measured. Next, ‘p’ is computed and finally the head- 
ing is computed using ‘p’ and R JS . 

60 According to another exemplary implementation, FIG. 6 
illustrates an exemplary technique for determining a stride 
length and a heading of a first responder. The exemplary 
implementation of FIG. 6 is an example of determining posi- 
tion of a mobile object (first responder) relative to an inertial 
65 frame. Such a 2 -dimensional inertial frame may be defined 
with respect to a fiducial point (such as an entry door, hallway, 
etc.). 
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Based on the geometry of FIG. 6, the stride length ‘W is 
defined as the displacement in the X-direction of the inertial 
frame. In this particular case, the stride length is measured as 
the horizontal displacement between the two sensor nodes B 
and D, which are provided at the heel-end of the first 5 
responder boots. It should be noted, that the stride length 
could also have been defined with respect to sensor nodes A 
and C, which are provided at the toe end of the boots. The 
heading ^V BA is defined as the rotation of the line connecting 
the two sensors provided on the front foot, with respect to the to 
one of the axes in the inertial frame. The separation distance 
is defined as ‘S^’, which is the distance between the sensor 
nodes B and D in the Y-direction of the inertial frame. 

The following equations can be derived from FIG. 6: 

6cz»&) _1 l’iJcfe-i)0«&) _ 9O°=O 

'i l Dcf, t k-l) + ^ACI>( t k)-^T( l k)-^ (>0 =0 

As discussed previously, the controller measures R_, c , 
R aD , R^, R ac , R^q, and R CD . Using the law of cosines, 2 s 
®cab> ®cdb> ®acdi and 9 A bd can be determined. As an 
example, 


15 


20 


( 1 ) 


6 ABD = arccos 


r BA + r BD ~ r AD 
2rBDBBA 


30 


Equations (1) provide a system of three linearly indepen- 
dent equations with four unknowns. Now, assuming that the 
heading from the previous step (i.e., v £ , az , c ) is known, only 
three unknowns (>P a4 , 67, and 9^) are left to be determined. 
By solving the above four equations, these three unknowns 
can be easily determined. Once *f* BA , and 9^ are deter- 
mined, the stride length ‘L H ’ and separation distance ‘S^/ can 
be determined as: 


N ( 2 ) 

x position = j L^ i 

i= 1 

N 

y position = ^ {s H . - ) 

;=i 

As indicated above, to calculate the x and the y positions, 
previous stride lengths and separation distances need to be 
stored. The storage unit 114 may store these values and the 
processing unit 113 may calculate the x and the y positions. 
Further, it is possible that the controller 110 may only calcu- 
late instantaneous stride lengths and separation distances and 
supply these to the central node, which then keeps track of the 
instantaneous values and determines the x and y positions. 

Next, an exemplary technique is described with reference 
to FIG. 7, in which the stride length, heading, and separation 
distances are calculated in a reference frame that changes 
based on the most recent foot fall. With this technique, the 
relative location of each foot can be determined during each 
step. However, to get the final location of the mobile object, 
values from this relative reference frame technique need to be 
transfonned or referenced to a fixed inertial frame. Further- 
more, the equations that are described next provide the ‘ V P Z3C ’ 
that was assumed as known for the equations of FIG. 6. 

Based on the geometry of FIG. 7, the following equations 
hold: 


-4 MV+ftfcoftit)- 90 0=0 
0=0 

The 0 CZ5a , Q acd values can be determined similar to FIG. 6. 
Therefore, the two unknowns <J> r and can be determined 
from the above two equations. 

Now, the following values can be readily determined: 

W~ r AC s i n 4>j 


hi~ r p,D sin $h 


d T =r AC cos 


L H -r B z) sin Q B 


djj r BD cos <|>, 7 


S BD cos Q h ^ 

In the above exemplary implementations, the measure- 
ments for the stride length and heading can be performed in a 
continuous manner or based on movement. If the measure- 
ments are performed in a continuous manner, the measure- 
ments can be made at predetennined time intervals irrespec- 50 
five of whether the object moves. If the measurements are 
based on movement, the controller can determine a specific 
moment at which the measurements are conducted. For 
example, the controller may determine the heading and stride 
length when one of the feet hits the ground. Also, the control- 55 
ler may determine the heading and stride lengths when the 
amplitude of the measured node distances reaches a maxi- 
mum or minimu m. The goal of these measurements is to 
generate a continuous or discrete time history of the move- 
ment of the nodes so that the full displacement nodes can be 60 
determined as required for a specific application or operation. 

The location of a mobile object in the X-Y plane (see FIG. 

6) can be determined as follows: based upon heel, with N 
number of steps, add up stride lengths, ‘L^’ of each step and 
change in stride width ‘V . Specifically, the x-position y-po- 65 
sition can be calculated over N steps using the following 
equations: 


In FIG. 7, l F zx: (i-l) is the same as 'P DC in FIG. 6. 

Next, the following two equations define a relationship 
between cftj-and <S> H , the heading (with respect to the inertial 
reference frame) of the previous foot step (left foot in this 
case) and variables 0^, and 0^: 


fee" 6 *- 0 ;/ 

Using the above two equations, the set of equations (1) can 
be solved. 

The final position of the mobile object can be expressed by: 


X position = ZM 

i=i 

Y position = 


rsin(i/r oc . t +(p Hi )] 


(3) 


si # H , 


N 


COSll/lDq j +<pH : ) 
COS (pH 1 


COSf^oq 2 +<fe,._ 1 F 
COS 


Techniques similar to those discussed above can be used to 
determine the 3-D position of a mobile object. Sensors such 
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as A, B, C, D would be placed in a vertical direction, or Z-axis 
direction, to create vertical ABCD plane as opposed to the 
horizontal ABCD plane described in FIGS. 2-6. The same 
solutions as described above with reference to FIG. 6 can now 
be created in an X-Z or Y-Z plane. By combining the X-Y 5 
solutions (FIG. 6) and the X-Z/Y-Z solution, a full three- 
dimensional solution can be obtained. For purposes of illus- 
tration, consider FIG. 8 in which sensors A, B, C, and D are 
provided on an area of the right and left legs extending from 
the knee to the ankle. The vertical distance between B and D to 
will correspond to the stride length in the vertical direction 
and the horizontal distance will correspond to the horizontal 
displacement in the Y-Z plane. 

Next, an exemplary method is described for determining 
the location of a mobile object. The exemplary method will be 15 
described in FIG. 9 and will refer to the system and techniques 
described above. Specifically, the exemplary method is 
described by referring to FIGS. 1, 2, 6 and/or 7. 

In S901, a controller 110 determines distances between 
sensor nodes placed on moving parts of a mobile object. 20 
Assuming that the mobile object is a first responder and the 
moving parts are his/her left and right feet, the controller 110 
measures R^ c , R so , R^, R ac , R^,, and R Cj r,. These values 
correspond to the distances between the different sensors (A, 

B, C, and D) placed on the left and right feet. Also, R JS and 25 
R co (distance between sensors on the same moving part, i.e., 
same foot in this case) can be directly measured and known 
prior to operation based upon their initial placement of these 
nodes in the boots. These are the values which the controller 
can measure directly. 30 

In S902, the controller 110 determines the stride length, the 
separation distance between the two feet, and the heading. 
These values may be calculated based on the assumed frame 
of reference (relative or absolute). Exemplarily, the values of 
stride length, separation distance may be determined based on 3 5 
the equations described with reference to FIGS. 6 and 7. 

In S903, the controller 110 may store these values in the 
storage unit 114 or may transmit them to the central node. 

In S904, the location of the mobile object is determined 
using the above calculated values. The location of the mobile 40 
object can be determined using equations (2) or (3) described 
above. 

The above exemplary implementations have been 
described with reference to a mobile object having two 
mobile parts (right foot and left foot) that move relative to 45 
each other. However, this can be extended to more than two 
mobile parts, for example four moving legs of a walking 
robot, as long as the proper set of nodes is chosen to represent 
each of the sets of feet. It should be noted that the above 
description focused on walking only for the purposes of illus- 50 
tration. These described techniques can be equally applied to 
any form of locomotion or node movement. Types of loco- 
motion may include walking, running, shuffling, side-to-side 
walking, crawling, walking up stairs, climbing ladders, etc. 

Exemplary implementations of the present disclosure 55 
directly support all aspects of personal navigation, including 
inside and outside of buildings or structures. These exemplary 
implementations are especially suitable for emergency 
responding personnel, but are also applicable to any form of 
personal navigation including tracking astronauts on celestial 60 
bodies. Aside from measuring absolute heading and position 
of an individual, the exemplary implementation allows for a 
reduced set of measurements that provides distances between 
nodes that can be directly utilized to determine displacements 
between parts of an individual’s body (e.g. arms, legs, torso), 65 
or parts on a robot (e.g. robotic amis, sensor appendages), or 
parts of other moveable objects on a device. 


8 

Exemplary implementation described above with refer- 
ence to flowchart illustrations and/or block diagrams of meth- 
ods, apparatus (systems) can be implemented using computer 
program products. It will be understood that each block of the 
flowchart illustrations and/or block diagrams, and combina- 
tions of blocks in the flowchart illustrations and/or block 
diagrams, can be implemented by computer program instruc- 
tions. These computer program instructions may be provided 
to a processor of a general purpose computer special purpose 
computer or other programmable data processing apparatus 
to produce a machine, such that the instructions, which 
execute via the processor of the computer or other program- 
mable data processing apparatus, create means for imple- 
menting the functions/acts specified in the flowchart and/or 
block diagram block or blocks. For example, instructions 
embodied on a computer-readable medium can be executed 
by a processor to provide the functionality of either the central 
node, the controller, and the sensor nodes (A, B, C). 

More generally, computer program instructions may be 
stored in a computer readable medium that can direct a com- 
puter, or other programmable data processing apparatus, or 
other devices to function in a particular maimer, such that the 
instructions stored in the computer readable medium produce 
an article of manufacture including instructions which imple- 
ment the function/act specified in the flowchart and/or block 
diagram block or blocks. 

The computer program instructions may also be loaded 
onto a computer, other programmable data processing appa- 
rams, or other devices to cause a series of operational steps to 
be performed on the computer, other programmable appara- 
tus or other devices to produce a computer implemented 
process such that the instructions which execute on the com- 
puter or other programmable apparatus provide processes for 
implementing the functions/acts specified in the flowchart 
and/or block diagram block or blocks. 

While the present invention has been particularly shown 
and described with reference to exemplary embodiments 
thereof, it will be understood by one of ordinary skill in the art 
that various changes in form and details may be made therein 
without departing from the spirit and scope of the present 
invention as defined by the following claims. 

What is claimed is: 

1. A system for determining a location of a mobile object 
including at least a first and second movable part, the system 
comprising: 

a central node; 

a controller coupled to the mobile object; and 

a plurality of sensors provided on each of the first and 
second movable parts, 
wherein: 

the controller is configured to determine distances between 
the plurality of sensors, and is further configured to 
determine a stride length, a heading, and a separation 
distance between the first and second movable parts 
using the determined distances, and 

the central node is configured to determine a location of the 
mobile object based on the determined stride length, 
heading, and separation distance. 

2. A method for determining a location of a mobile object 
including at least a first and second movable part, the method 
comprising: 

determining distances between a plurality of sensors pro- 
vided on the first and second movable parts; 

computing a stride length, heading, and separation distance 
between the first and second movable parts based on the 
determined distances; and 
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computing a location of the mobile object based on the 
computed stride length, heading, and separation dis- 
tance. 

3. A computer readable storage medium embodied with 
program code for enabling a computer to perform a method of 5 
determining a location of a mobile object including at least a 
first and second movable part, the method comprising: 

determining distances between a plurality of sensors pro- 
vided on the first and second movable parts; 

computing a stride length, heading, and separation distance to 
between the first and second movable parts based on the 
determined distances; and 

computing a location of the mobile object based on the 
computed stride length, heading, and separation dis- 
tance. 15 

4. The system of claim 1, wherein at least one of the stride 
length, heading, and separation distance is computed using a 
distance between sensors on the first movable part or the 
second movable part. 

5. The method of claim 2, wherein at least one of the stride 20 
length, heading, and separation distance is computed using a 
distance between sensors on the first movable part or the 
second movable part. 

6. The computer readable storage medium of claim 3, 
wherein at least one of the stride length, heading, and sepa- 25 
ration distance is computed using a distance between sensors 
on the first movable part or the second movable part. 



